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Abstract 

In this paper, several attitude estimation designs are developed for the Tropical 
Rainfall Measurement Mission (TRMM) spacecraft. A contingency attitude 
determination mode is required in the event of a primary sensor failure. The final 
design utilizes a full sixth-order Kalman filter. However, due to initial software 
concerns, the need to investigate simpler designs was required. The algorithms 
presented in this paper can be utilized in place of a full Kalman filter, and require 
less computation^ burden. These algorithms are based on filtered deterministic 
approaches and simplified Kalman filter approaches. Comparative performances of 
all designs are shown by simulating the TRMM spacecraft in mission mode. 
Comparisons of the simiilation residts indicate that crmiparable accuracy with 
respect to a full Kalman filter design is possible. 


Introduction 

The TRMM spacecraft is due to be launched in 1997 with a nominal mission lifetime of 42 ninths. 
The m^ objwtives of this mission include: (1) to obtain multi-year measurements of tropical and 
subtropical rainfall, (2) to understand how interactions between the sea, air, and land masses produce 
changes in global rainfall and climate, and (3) to help improve the modeling of tropical rainfall processes 
and their influence on global circulation. 

"nie ^acecraft is three-aMS stabilized in a near circular (350 km) orbit with an inclination of 35°. The 
nominal Earth-pointing mission mode requires a rotation once per orbit about the spacecraft’s y-axis. 
The attitude determination hardware consists of an Earth Sensor Assembly ^SA), Digital Sun Sensors 
(DSS), Coarse Sun Sensors (CSS), a Three-Axis Magnetometer (TAM), and gyroscopic rate sensors. 
The attitude control hardware includes three Magnetic Torquer Bars (MTB) which are used to provide 
magnetic momentum unloading capability, and a Reaction Wheel Assembly (RWA) which consists of four 
wheels in a pyramidal arrangement to maximize momentum storage capability along a preferred axis. 

Primary attitude determination is accomplished using the ESA and gyroscopes. The DSS is also used 
twice each orbit in order to update the yaw position estimate during mission p>ointing. The allotted 
attitude knowledge accuracy is 0.18° per axis. Simulation studies indicate that the primary attitude 
detemtination system meets the knowledge i^uirements [1]. In the event of an ESA failure, a 
contingency nKxie is used to allow for the continuation of the scientific mission. Attitude determination 
for the contingency mode is accomplished using the DSS, the TAM, and gyroscopes. The allotted 
attitude knowledge accuracy for the contingency mode is 0.7° per axis. 

The algoriAm chosen for the final contingency design incorporates a sixth-order Kalman filter [2]. 
ITus filter estimates both attitude error angles and gyro drift trajectories. However, due to iiutial 
concerns in software coding size and computations, the development of simpler and less software- 
intensive algorithms is required. A number of algorithms is presented in this paper, including: an 
Isotropic Kalman Filter (IKF), a steady-state Angles-only Kalman Filter (AKF), an Enhanced TRIAD 
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Algorithm (ETA), and an Enhanced QUEST Algorithm (EQA). All of these algorithms utilize magnetic 
field measurements, digital sun sensor measurements (when available), and gyro measurements. The 
is a sinq>lified Kalman filter in which an approximation is made where the rank deficient projection matrix 
is replaced by the identity matrix. This leads to attitude and gyro bias covariances that are the same in all 
directitxis in space. The AKF is a steady-state Kalman filter which estimates for angles only, vdth no 
gyro bias estimation. The ETA is essentially a first-order filter on TRIAD [3] determined attitudes. 
During solar eclipse, the ETA relies exclusively on noodel propagation using gyro meas^ments. Also, 
during sensor co-alignment the filter gain is automatically adjusted so that the filter relies more on the 
propagated attitude. The EQA is similar to the ETA, but uses the QUEST [4] algorithm for attitude 
determination. This allows for weighting of individual attitude sensor measurement sets. 

The organization of this paper proceeds as follows. First, a summary of the spacecraft attitude 
kinematics is shown. Then, a brief review of the standard Kalman filter us^ for attitude estimation is 
shown. Next, the equations and properties of the KF, AKF, ETA, and EQA are presented. Then, these 
algorithms are used to estimate the attitude of a simulated TRMM spacecraft. Rnally, resitits are shown 
which compare each new algorithm to the full Kalman filter. A number of factors is considered, 
including: telemetry requirements, on-board requirements, coding size, and attitude accuracy. 


Attitude Kinematics 

In this section, a brief review of the kinematic and dynamic equations of nrotion for a three-axis 
c tahiiWftH spacecraft is shown. The attitude is assumed to be represented by the quaternion vector, 
defined as 





( 1 ) 


with 



= nsin(0/2) 




(?4 = cos(0 / 2) 


(2a) 

(2b) 


where n is a unit vector corresponding to the axis of rotation and 0 is the angle of rotation. The 
quatemicMi kinematic equations of motion are derived by using the spacecraft’s angular velocity (w), 
given by 



(3) 


where t2(c») and are defined as 


-[cox] : 




(4a) 



<74/3x3 +[«i 3 ><] 



(4b) 


The 3x3 dimensional matrices [mx] and [f| 3 ^] ^^e referred to as cross product matrices since 
axft = [ax]ft, with 
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(5) 


0 -03 <»2 
03 0 -0| 

-02 Oi 0 

Since a three degree-of-fireedom attitude system is represented by a four-dimensional vector, the 
quateroicms cannot be independent. This condition leads to the following normalization constraint 

= =1 ( 6 ) 

The measurement model is assumed to be of the form given by 

Bb=a(^Bj (7) 

where is a 3x1 dimensional vector of some reference object (e.g., a vector to the sun or to a star, or 
the Earth’s magnetic field vector) in a reference coordinate system, is a 3xi dimensional vector 
defining the components of the corresponding reference vector measured in the spacecraft body frame, 
and a(£) is given by 

/>(?) = (4 -£[3«,3)/3x 3 + 2£,3«J3 -2?4[«,3 x] (8) 

which is the 3x3 dimensional (orthogonal) attitude matrix. 




Kalman Filter Review 

In this section, a review of the basic principles of the Kalman filter applied to attitude estimation is 
shovm (see [2] for more details). The state error vector has seven components consisting of a four- 
component error quaternion (6^) and a three- vector gyro bias error A6, given by 

8^ ' 

Ax = (9) 

Ab 

The error quaternion is defined as 

bq = q®^^ (10) 


where £ is the true quaternion and £ is the estimated quaternion. Also, the operator ® refers to 

quaternion multiplication (see [3] for details). Since the incremental quaternion corresponds to a small 
rotation. Equation (10) can be approximated by 



which reduces the four-component error quaternion into a three-component (half-angle) representation. 


The true angular velocity is assumed to be modeled by 




( 12 ) 


where M is the true angular velocity, co^ is the gyro-determined angular velocity, and b is the gyro drift 
vector, which is modeled by 
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(13) 


b = i\ 


-12 


The 3x1 vectors, ijj and are assumed to be modeled by a Gaussian white-noise process with 

%,.(0} = 0 i = 1.2 


(14a) 


(O} = (2/5,y5(r-0 ij = 1,2 


(14b) 


Using the reduced error quaternion in Equation (11) and the gyro drift model in Equation (13), the 
state error equation may be written as [2] 

M = FAx+Gw (15) 

where 


F = 


-[ ax ] ~ l . 


3x3 


G = 


03x3 hx3 


~^hx3 03x3 


03x3 hx3 


w = 


Hi 

L^^2J 


State-observable discrete measurements are assumed to be modeled by 

~ ^k{^k)'^^k 

where 


(16a) 


(16b) 

(16c) 

(16d) 

(17) 

(18) 


and Vj^ is assumed to be modeled by a zero-mean Gaussian process with 


OI 

II 

1^ 

(19a) 

^{vtv/'}=S«Rt 

(19b) 

The sensitivity matrix can be written as 

«*=['* ; 03 x 3 ] 

(20) 

where 


(21) 
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The extended Kalman filter equations for attitude estimation are summarized by 


p=fp+p'^f+gqg'^ 

(22a) 

Ait -**(?*(-))] 

(22b) 

ni+) = [/6X6 -^t ffi(ii(-))]Pi(-) 

(22c) 

= n(-)Hk[Hk n(-)Hk +«t]"‘ 

(22d) 

«(+) = 8|(+)®^-) 

(22e) 

M+)=M-)+am+) 

(22f) 

«£(+)= 

(22g) 


Isotropic Kalman Filter 

In this section, the equations for the IKF are shown. The state vector consists of an incremental 
quaternion and gyro bias. The gyro propagation portion of the IKF is identical to the full Kalman filter 
shown in the previous section. However, the assumed measurement in the IKF is given by 

z=uxu (23) 

where « is the measured unit vector from either the TAM or DSS in the body frame, and u is the 
corresponding expected value, obtained by mapping the inertial reference to the body-fixed coordinate 
system using the estimated quaternion. Also, from Equation (23) 1 = 0, since the cross product of a 
vector with itself is zero. The sensitivity matrix of the measurement model in Equation (23) is determined 
by using the attitude matrix of the angle error. This leads to 

M = A(a)u (24) 

where a is an incremental error angle. Using the approximation 

^(a) = /3x3-[ax] (25) 

leads to the following measurement model 

I = (^3x3-“«^)« (26) 

Therefore, the sensitivity matrix, which contains partials with respect to the error state, is given by 

H = [Hu ; 03x3] ( 27 ) 

where 

Hu=hx3-M^ (28) 

This matrix is the pnojection operator onto the space perpendicular to u, which reflects the fact that an 
observation of a unit vector contains no information about rotations around an axis specified by that 
vector. Therefore, //„ has rank two. Also, if the measurement errors for each sensor are assumed equal 
in all directions, then the measurement error covariance is given by 

R = rHu (29) 
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where r is a scalar. Equation (29) indicates that there is no uncertainty in the length of the measured 
vector. The IKF is derived by ma^g an approximation of replacing the rank-two sensitivity matrix in 
Equation (28) by the rank-three identity matrix, which leads to 

W«=/ 3 x 3 (30a) 

/? = r/3x3 (30b) 

This approximation leads to attitude and gyro bias covariances which are equal in all directions in space, 
or isotropic. Therefore, the covariance matrix has the form given by 

Pahx3 Pchx3 ^ 21 ) 

lPchx3 P*^3x3j 

where Pa, Pc y Pb 2re scalar quantities. Also, the state transition matrix is approximated by 




hx3 -At/3x3 
03x3 hx3 . 


(32) 


where zu is the sampling interval. Equation (32) ignores spacecraft rotation, which is irrelevant since the 
covariance matrix in Equation (31) is isotropic. The covariance propagation equations are now given by 


Pa,,, (-) = Pa, i+)-^Pc, i+)^ + Pb, (+)A^^ +0 jAr-l-iajA /3 
Pc,„ (-) = Pc, i+)-Pb, {+)^-\<yW 


(33a) 

(33b) 


Pb,„ (-) = Pb, (+)+<^uA/ (33c) 

where and are the scalar covariances of the gyro-drift ramp noise, and the gyro-drift rate 
measurement noise, respectively. The Kalman gain matrix is given by 

^ = [*fl/3x3 : hhx3f (34) 

where 




h = 


?«..,<-)+'■ 


Therefore, the Kalman covariance and state update equations are given by 

Pc.J*) = rki, 

Pb.J+) = Pb,J-)-l‘bPc.J-) 


«t+lW = 


1 




tk+\ (+) = h+l (-) + (k X m) 


(35a) 

(35b) 

(36a) 

(36b) 

(36c) 

(37a) 

(37b) 
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Since, Equations (37a) and (37b) depend on the cross product measurement (Sxu), the updates to the 
quaternions and biases are still perpendicular to u despite the approximation to the sensitivity matrix. 


Steady-State Angles-onlv Kalman Filter 

In this section, a simplified version of the fiiU Kalman filter is shown. The AKF estimates only the 
quaternion, and not the gyro drift. The covariance and state transition matrices are the upper 3x3 blocks 
of the corresponding matrices in a full Kalman filter. Therefore, covariance propagation is given by 

= + (38) 

where w is the assumed scalar level of the process noise. A full angles-only Kalman filter rapidly 
approaches steady-state using the covariance propagation in Equation (38). Therefore, a steady-state 
covariance is used. An investigation of the eigenvalues of the covariance matrix shows that there is one 
large eigenvalue {pmax)y and two nearly equal smaller eigenvalues {p^). Also, the eigenvector 

corresponding to p^ is found to always be within 2.5 degrees of the sun vector in the body. This 

reflects the fact that the more accurate sun sensor cannot reduce attitude errors along the sun line, which 
must be estimated using the less-accurate TAM. Therefore, the covariance matrix is given by 

^ ~ Peye ^3x3 Psun (39) 


where £_ is the sun vector in the body frame, and p^y^ and p^^ are constants. The minimum eigenvalue is 
given by and the maximum eigenvalue is given by p^y^ + p^^. 

Sun Sensor Update 

The sensitivity matrix and measurement covariance for the sun sensor are given by 

//,=[sx] (40a) 

R, = r, ( 3^3 (40b) 

where s_ is the estimated sun vector in the body frame, and r, is the scalar (isotropic) measurement 
covariance. The Kalman gain for the sun sensor update requires the computation of 

{HsPHJ ={Peyc[l><Il><f 

1 

r? Peye 


\hx3 + 


A A T' 

Peyell 


( 41 ) 


Therefore, the Kalman gain matrix is given by 

k, = phJ{h,phJ -^R,] 


-1 


= y^^{Peyehx3+Psunif\i^'! 


PgygSS ^^ 


(42) 


=-5a»_[|xf 

Peye 

If the measurements are processed at a given time by accumulating an incremental error angle a 
initialized at zero, without re-computing the quaternion between updates, the state update becomes 
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(43) 


«(+) = «(-)+ - {? X I - (/3x3 - if )a(-)| 

Peye 

where ? is the measured sun vector in the body frame. 

TAM Update 

The sensitivity matrix and measurement covariance for the TAM are given by 

//,=[mx] (44a) 

/?,=/i/3x3 (44b) 

where m is the estimated magnetic field vector in the body frame, and r, is the scalar (isotropic) 

measurement covariance. The Kalman gain for the TAM update requires the computation of 

{//,/»///’+/?,} (45) 

The inverse in Equation (45) is computable in closed form, but is complicated. An approximation is made 
which assumes r, is much larger than both and Therefore, Equation (45) is re-written as 

[h,PhJ +R,}~^ (46) 

The Kalman gain matrix is now given by 

K, = PHJ \h,PHJ + Rt}~^ 

ir , iT 

==—[Peyehx3+Psunls jlmxj 

The state update is given by 

a(+) = a(-)+^{pgye/3x3 + P5«flll^}{^xm-(m^m/3x3-mm^)a(-)} (48) 

where m is the measured TAM vector in the body frame. 


Enhanced TRIAD and QUEST Algorithms 

In this section, the ETA and EQA are developed. These algorithms are essentially based on an 
“alpha-type” [5] filter implied to deterministic methods. The TRIAD algcaithm [3] involves the 
construction of two triads from a pair of orthonormal vectors, u and y_, with basis vectors given by 

/ = M (49a) 


MXV 



n = lxm 


(49b) 

(49c) 


The basis vectcnrs are constructed for both body measured vectors ug and vg, and for the inertial 
reference vectors and v; . Two orthogonal 3x3 matrices are then constructed, given by 

^B=[Lb UkB 3b] (50a) 

Af/=[// mj nj] (50b) 

The attitude matrix maps the inertial reference to the body frame, and can be determined by 
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(51) 


A = MbMJ 

An accurate niethod for extracting the quaternions from the attitude matrix is given in [6]. 

The TRIAD method (as well as all deterministic) methods requires at least two sets of vector 
measurements to determine the attitude matrix. This method subsequently fails when only one set of 
vector measurements (e.g., TAM data only) is available. Also, deterministic methods fail when vectors 
are co*aligned (i.e., |« y| = l). These difficulties are overcome by combining the TRIAD determined 
quaternions with a gyro-propagated model and a simple first-order filter. The ETA is given by 

?^(+) = cxp{ia(Sj)Ar}«(-) (52a) 

^(+) = (l“«)^p(+)+«^,^^(+) (52b) 

where q is the propagated quaternion, £ is the estimated quaternion, and is the quaternion 
extracted from the TRIAD determined attitude matrix. The scalar gain variable a is given by 

a = (l-l«xy|^ jaq (53) 


where Oq is a constant gain. The filter gain in Equation (53) is automatically adjusted to accommodate 
periods of vector co-alignment (i.e., as the vectors become co-aligned, the gain approaches 0). Also, Oq 
is set to zero when only one measurement set is available. 


The ETA is essentially a first-order “additive” Kalman filter. In general, this approach will not 
maintain quaternion normalization [7]. To investigate how the ETA affects quaternion normalization, 
Equation (52b) may be re-written as 







(54) 


where is the identity quaternion. If the propagated quaternion is close to the TRIAD determined 
quaternion, then Equation (54) can be approximated accurately by 


A 

Q 





—a 50 
2 " 


1 


(55) 


where 50 is the angle vector between and q^^- Therefore, since Oq is very small, normalization is 

maintained to within first-order. For numerical precision, the quaternions are explicitly normalized. 

The EQA is similar to the ETA, but uses the QUEST [4] algorithm to determine attitude. The 
QUEST algorithm nrinimizes the following cost function [8] 

= (56) 

k=\ 

where w is a set of unit vector observations in the body-frame, y_ is a set of imit observations with respect 
to the inertial frame, and n is the total number of vector measurement sets. The constants a* serve to 
weight individual sensor measurements. Shuster [4] has shown that the maximum-likelihood estimate of 
the attitude is obtained with weights given by 

n 

where a* is the standard-deviation of the measurement error process for each sensor. 
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TRMM Simulation and Results 

In order to compare the algorithms developed in this paper, a simulation study is performed using 
TRMM orbit parameters and performance criteria. The simulated spacecraft has a near circular orbit at 
350 km, and completes an oibit in approximately 90 minutes. The nominal mission mode requires a 
rotation once per orbit (i.e., 236 deg/hr) about the spacecraft’s y-axis while holding the remaining axis 
rotations near zero. The “true” magnetic field reference is modeled using a 10th order International 
Geomagnetic Reference Field (IGRF) model. In order to simulate magnetic field modeling error, a 6th 
order IGRF is used to develop “measiuements.” TAM sensor noise is modeled by a Gaussian white- 
noise process with a mean of zero and a standard deviation of 0.5 mG. The two DSS’s each have a field 
of view of about 50° x 50°. The body to sensor transformations for each sensor is given by 

■-0.5736 0 -0.8192' 

Ti= 0.4096 0.866 -0.2868 (58a) 

0.7094 -0.5 -0.4967 

'-0.5736 0 0.8192' 

T2 = -0.4096 0.866 -0.2868 (58b) 

-0.7094 -0.5 -0.4967 

Each DSS views the sun when the sensor view is greater than the cosine of 50°. The two DSS’s combine 
to provide sun measurements for about 2/3 of a complete orbit. The DSS sensor noise is also modeled 
a Gaussian white-noise process with a mean of zero and a standard deviation of 0.05°. The gyro 
“measurements” are simulated using Equations (12) and (13), with a gyro noise standard deviation of 
0.062 deg/hr, a ramp noise standard deviation of 0.235 deg/hr/hr, and an initial drift of -0. 1 deg/hr on 
each axis. 

A plot of the roll, pitch, and yaw attitude errors for a typical simulation mn using the full Kalman 
filter is shown in Figure 1. A plot of the corresponding gyro-bias estimates is shown in Figure 2. From 
Rgure 1, the roll and yaw attitude errors show a strong dependence on orbit rate which is centered at 
zero, and a pitch error which is biased. This error bias may be due to non-Gaussian tiKxleling errors in 
the magnetic field “measurements.” These nonlinearities cause an error in inertial space wMch is not 
zero-mean and is largely along the sun line. When these errors are mapped into the body frame, 
sinusoidal motions occur in roll and yaw which are 90° out of phase from each other. Also, a biased 
error occurs in pitch which has the same magnitude as the sinusoidal motion, since the sun vector is 45° 
off the pitch axis. This can be shown mathematically by redefining an inertial reference fixed on the orbit 
plane with the x-axis tangent to the orbit plane, the z-axis point^ nadir, and the y-axis completing the 
triad. For a zero rotation, the inertial reference corresponds to the body fi^ame. Therefore, finom Figure 1 
a starting value for the inertial reference can be chosen such that the z-axis is zero, and the remaining axes 
equal in magnitude. The mapping to the body frame for a rotation about the y-axis is given by 

cos(p) 0 sin(|x) cos(p.) 

c = 8 0 1 0 ^ = 1 (59) 

-sin(|j,) 0 cos(|i) ^ -sin(p) 

where p is the true anomaly, 5 is the magnitude of the error, and s_ is the direction of the sun vector, 
given by. 



Qearly, a sinusoidal motion and constant bias is shown by Equation (59). This effect is also seen when 
using a Kalman filter on other spacecraft (e.g., UARS and SAMPEX). However, the full Kalman filter is 
able to estimate attitudes to within 0.1°, and estimates the gyro-drift fairly accurately. 
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A plot of the attitude errors for a typical simulation run using the IKF is shown in Figure 3. There is 
no clear orbit rate dependence in roll and yaw for this algorithm, but all angle errors are now biased. This 
may te due to the fact that the IKF assumes that the attitude covariance is equal in all directions, so that 
any biased errors are translated into all axes. The gyro-bias estimates (shown in Figure 4) are estimated 
more accurately using the IKF, as compared to the full Kalman filter. However, comparing magnitude 
attitude errors in Figiue 3 to Figure 1 shows that attitude acciffacy is no better than the full Kalman filter. 

A plot of the attitude errors using the AKF is shown in Figure 5. The errors in roll and pitch are 
biased, while the yaw error has a mean near zero. These errors are likely due to not correcting for gyro 
bias in the filter. This is further depicted in the attitude covariance matrix, which is an order of magnitude 
larger than the full Kalman filter attitude covariance. However, attitude accuracy is stiU comparable to 
the full Kalman filter (i.e., within 0.1°). 

A plot of the attitude errors using the ETA is shown in Figure 6. The peak errors seen predominately 
in the pitch and yaw errors are due to periods of sun un-observability. During these periods, the filter 
gain (shown in Figure 7) is set to zero, so that attitude is determined from gyro-propagation solely. Also, 
the gain clearly shows a sinusoidal motion. This motion compensates for measurement vector co- 
ali^ment Attitude accuracy for this simple approach is within 0.15°. Also, the EQA improves the 
attitude accuracy slightly, but not to any appreciable amount 

Table 1 shows a summary of telemetry requirements, on-board table (initialization) requirements, 
code size, and performance results for each algorithm described in this paper. Qearly, comparable 
performance with respect to the full Kalman filter is possible using either the or AKF. Also, the AKF 
requires less telemetry and table values, and requires less coding size than either the full Kalman filter or 
the IKF. The ETA requires the least amount of telemetry and table values, and requires the least amount 
of coding. Even though attitude accuracy is slightly degraded as compart to the full Kalman filter, the 
simulation study indicates that the 0.7° attitude Imowledge requirement is clearly met 


Table 1 Telemetry and Table Values, Code Size, and Performance 



FuUKF 

IKF 

AKF 

EQA 

ETA 

Telemetry 

~40 values 

~25 values 

~15 values 

~5 values 

~5 values 

Table 

~30 values 

~20 values 

~15 values 

~8 values 

~5 values 

Code Size 

<6K 

<4K 

<4K 

<2K 

<1 K 

Performance 







Conclusions 

A number of alternatives to using a full Kalman filter for attitude estimation was presented in this 
paper. In order to quantify the performance of these proposed algorithms, a simulation study was 
performed for the TRMM spacecraft. The results of this simulation study indicated that comparable 
accuracy with respect to a full Kalman filter design is possible. In particular, the ETA was shown to be 
an effective attitude estimator, while at the same time dramatically decreasing coding size, and telemetry 
and on-board requirements. Although the full Kalman filter was chosen for the final contingency mode of 
TRMM, the study presented in this paper provided valuable alternatives for futme attitude estimation 
schemes. 
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Figure 3 Isotropic Kalman Filter Attitude Errors 
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